DUDLEY KNOX LIBRARY 
naval postgraduate school 

MONTEREY, CALIFORNIA 93943-600-8 



NAVAL POSTGRADUATE SCHOOL 



Monterey, California 



THESIS 



STATE-SPACE ANALYSIS OF 
THE TRIDENT II MARK 6 GYRO 
by 

David L. Krueger 
March 1986 



Approved for public release; distribution is unlimited. 




Thesis Advisor: 



D. J. Collins 




Try Classification op This page 



REPORT DOCUMENTATION PAGE 



PORT SECURITY CLASSIFICATION 

UNCLASSIFIED 



lb RESTRICTIVE MARKINGS 



CURITY CLASSIFICATION AUTHORITY 



CLASSIFICATION / DOWNGRADING SCHEDULE 



3 DISTRIBUTION/ AVAILABILITY OF REPORT 

Approved for public release; 
distribution is unlimited. 



FORMING ORGANIZATION REPORT NUM0ER(S) 



5 MONITORING ORGANIZATION REPORT NUMBER(S) 



\ME OF PERFORMING ORGANIZATION 

111 Postgraduate School 



6b OFFICE SYMBOL 
(If applicable) 

67 



7a NAME OP MONITORING ORGANIZATION 

Naval Postgraduate School 



DRESS (Cry. Sfafe, and ZIP Code) 

pnterey, California 93943-5000 



7b ADDRESS (C/fy, Sfafe. and ZIP Code) 

Monterey, California 93943-5000 



ME Of FUNDING /SPONSORING 
GANIZATION 



8b OFFICE SYMBOL 
(If applicable) 



9 PROCUREMENT INSTRUMENT IDENTIFICATION NUMBER 



DRESS (City, State, and ZIP Code) 



10 SOURCE OF FUNDING NUMBERS 



PROGRAM 


PROJECT 


TASK 


WORK UNIT 


element NO 


NO 


NO 


ACCESSION NO 



'LE (Include Security Clarification) 

STATE-SPACE ANALYSIS OF THE TRIDENT II MARK 6 GYRO 



1SONAL AUTHOR(S) 



Krueger, David L. 



'PE OF REPORT 

:er's Thesis 



1 3b TIME COVERED 


14 DATE OF REPORT (Year. Month. Day) 


IS PAGE COUNT 


FROM TO 


1986 March 


70 



ELEMENTARY NOTATION 



COSATI CODES 



LD 


GROUP 


SUB-GROUP 















18 SUBJECT TERMS (Continue on reverse if necessary and identify by block number) 

Gyro; Mark 6 Gyro; Trident II missile system; 
optimal control; region controller 



■ TRACT ( Continue on revene it ne<euary and identify by blcxk number) 

This thesis conducts a state-space analysis of the Mark 6 gyro used in the 
'rLdent II missile system. Optimal control techniques-, utilizing a region ccn- 
‘ ■'oiler, have been employed in designing a gyro controller. The response of the 
astern to missile motion is examined and compared to the system response using 
he current control laws. It is shown that an optimal region controller reduces 
he gyro error in the system while effectively avoiding gimbal lock, a situation 
rich exists when gyro orientation prevents missile moticn from being isolated 
i an orthogonal three axis coordinate system. Recommendations for the application 

■ additional modern control techniques are included. 



■ rniBunON / AVAILABILITY Of ABSTRACT 

hCLASSlflEDUNLlMlTED □ SAME AS RPT □ DTlC USERS 



21 ABSTRACT SECURITY CLASSIFICATION 

UNCLASSIFIED 



4 me of RESPONSIBLE INDIVIDUAL 

rmiel J. Collins 



220 A,eiCode> 



-zozb 



22c OFFICE SYMBOL 

67 



RM 1473, 84 mar 



83 APR edition may be used until e*hausted 
All other editions are obsolete 



SECURITY CLASSIFICATION OF THIS PAGE 



Approved for public release; distribution is unlimited. 



State-Space Analysis 
Of 

the Trident II Mark 6 Gyro 



by 



David L. Krueger 
Lieutenant, United States Navy 
B. S. , United States Naval Academy, 1979 



Submitted in partial fulfillment of the 
requirements for the degree of 



MASTER OF SCIENCE IN AERONAUTICAL ENGINEERING 



from the 



NAVAL POSTGRADUATE SCHOOL 
March 1986 



ABSTRACT 



This thesis conducts a state-space analysis of the Mark 
6 gyro used in the Trident II missile system. Optimal 
control techniques, utilizing a region controller, have been 
employed in designing a gyro controller. The response of 
the system to missile motion is examined and compared to the 
system response using the current control laws. It is shown 
that an optimal region controller reduces the gyro error in 
the system while effectively avoiding gimbal lock, a situ- 
ation which exists when gyro orientation prevents missile 
motion from being isolated in an orthogonal three axis coor- 
dinate system. Recommendations for the application of addi- 
tional modern control techniques are included. 
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I. INTRODUCTION 



A need for accurate, self-contained navigation systems 
has existed since the early days of aircraft design. The 
most common of these systems uses accelerometers to deter- 
mine body motion. The output signal is integrated once to 
obtain velocity and again to obtain position. 

In order for the navigation system to accurately deter- 
mine body motion the sensors must be mounted on a platform 
fixed in a known coordinate system. In ballistic missile 
guidance systems, gyros are used to fix a platform in iner- 
tial space. The accelerometers are mounted on this plat- 
form. The purpose of the gyro controller, then, is to 
generate the gyro torque motor commands necessary to main- 
tain the stable platform fixed in inertial space. 

Since 1957, the Charles Stark Draper Laboratory in 
Cambridge, Massachusetts has designed the gyros for the 
Navy's Polaris, Poseidon and Trident missiles. Because of 
the complex, highly non-linear nature of the control system, 
this design process has been a tedious, iterative affair. 
Using state-space representation of systems, computer-aided 
optimal control design techniques greatly simplify the 
multi-input, multi-output non-linear time varying problem. 
The goal of this thesis is the development of a state-space 
model of the Trident II gyro system, the Mark 6, and the 
application of modern control theory to improve system 
performance . 

A state-space model of the system has been developed and 
is compared to the current gyro model. Transient response 
of both systems to missile motion is examined. Modern 
control techniques using optimal feedback gains are employed 
to minimize gyro errors and improve system response. The 
choice of optimal feedback gains is made based on a region 
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controller which selects the gains dependent upon the 
particular gimbal angles. Finally, suggestions are made for 
employing modern control techniques to further optimize 
system performance. 
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II. FUNCTION OF THE GYRO CONTROLLER 



A. THE ALL-ATTITUDE GIMBAL ASSEMBLY 

The inertial navigation system for a ballistic missile 
must accurately determine missile motion in three orthogonal 
planes. Missile motion is resolved by accelerometers 
mounted on a platform fixed in inertial space. A three 
dimensional coordinate system is initialized before missile 
launch, and remains fixed through out the flight. The func- 
tion of the gyro controller is to keep the stable platform 
fixed throughout the flight. 

The Mark 6 gyro consists of four concentric gimbals as 
shown in Figure 2.1 [Ref. 1: p. 2]. The innermost gimbal is 
the stable platform, housing the accelerometers. As the 
missile experiences pitch, roll and yaw a torque is applied 
to the gimbals in such a manner as to isolate the stable 
member from the motion. 

1 . Gimbal Lock 

In addition to maintaining a fixed inertial refer- 
ence, the gyro controller must prevent "gimbal lock". This 
occurs when the gimbals are co-planar and it becomes impos- 
sible to isolate missile motion on three orthogonal axes. 
Controlling the gyro errors is relatively straightforward, 
while preventing gimbal lock is more complex. Since the 
gimbal angles can assume any value during missile flight, 
the problem becomes non-linear and difficult to solve. The 
technique developed by Draper Laboratory for preventing 
gimbal lock will be employed in the design of the state- 
space system model. This technique is more fully described 
in the next chapter. 

2 . Missile to Stable Member Motion Coupling 

The four gimbal IMU model is shown in Figure 2.2 
[Ref. 2: p. 2]. Missile, or b ase motion occurs in the 
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INNER MIDDLE 




Figure 2.1 Four Gimbal Gyro Model. 

coordinate system. This motion is coupled to the 
stable member coordinate system by the outer, 

middle and inner gimbals. The system accuracy is measured 
by the gyro error of the stable member in the 
space. Appendix B contains the detailed transformation of 
missile motion in the base frame of reference to motion in 
the inertial frame. 
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Figure 2.2 Four Gimbal Gyro Coordinate Systems. 
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III. MARK 6 GYRO MODEL 



A. BLOCK DIAGRAM 

The Mark 6 Gyro model presently being used by Draper 
Laboratory is shown in Figure 3.1 [Ref. 2: p. 8]. Table III 
in Appendix A contains a definition of abbreviations used in 
this thesis. The torque motor commands are the inputs to 
the system, with the gyro errors and gimbal angles as the 
output. The diagram illustrates the cross- coupling between 
gimbals represented by the input equations shown in Figure 

B. 1. 

1 . Plant Diagram 

a. Signal Conversions 

Figure 3.1 contains the electrical and mechan- 
ical realizations of the Mark 6 gyro. The input signal is 
expressed in terms of quanta, with one quanta equal to 
0.0735 volts. The torque command is expressed in ounce- 
inches. The gimbal angles, given in radians, are converted 
to quanta for input to the feedback controller. 

b. RGyro 

Also shown on the diagram is the RGyro. This is 
not a part of the plant. The RGyro defines an error associ- 
ated with the roll axis. In earlier three gimbal gyros, the 
roll axis of the missile did not coincide with any of the 
gimbal axes. The four gimbal Mark 6 gyro aligns the roll 
axis with the outer gimbal axis, thus eliminating the need 
for the RGyro as an indication of gyro error. The output is 
still provided for ease in comparing current model errors 
with previous systems. 

c. Gimbal Inertias 

The gimbal inertias are represented in Figure 
3.1 as Jg, Jj, and Jq for the stable member and inner, 

middle and outer gimbals respectively. The outer and middle 
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Figure 3.1 Mark 6 Gyro Model (Inertial Mode). 



14 



I00H2 





gimbal inertias change with time as a function of the inner 
gimbal angle. Figure 3.2 shows how the inertias are 
resolved [Ref. 2: p. 6]. 




y 



= r-^cos 0 

resolving along the x and y axes: 

p p p p 

J x = l y m = r^m sin' 1 0 = J^in' 1 0 

* p p p p 

Jy = l x m = r^m cos' 1 0 = J Q cos 0 




for the four gimbal model: 

J M + J I + J S C I 2 

J 0 + J M + J I C M 2 +J S C M 2s I 2 



Figure 3.2 Resolution of Outer and Middle Gimbal Inertias. 
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d. Stable Element 



The stable member is represented by the upper 
flow path in Figure 3.1. There are no external inputs to 
the stable member, with only friction affecting the loop. 
The stable element is controlled by its own feedback loop 
and is not influenced by the other system signals . Signals 
from the stable loop do cross-couple to the other gimbals, 
however, with the torque command coupling to the middle and 
outer gimbals. The inertial rate S serves as an input to 
the stable member angle, shown at the bottom of the figure. 
This angle could also be shown connected to the stable 
element flow path, with an input from the outer gimbal iner- 
tial rate. Because the stable member is affected only by 
friction, it has not been included in the state-space model. 

e. Sampling Rates 

Two different sampling rates are used in the 
system. The U, V and W gyros are sampled at 300 Hz. The 
gimbal angles are sampled at 100 Hz. 

f. Gimbal Lock Avoidance 

The proximity of the system to gimbal lock can 
be measured by observing the sines of the inner and middle 
angles. The product SIN (Aj )*SIN (A^) gives an indication of 
how close the system is to gimbal lock, with gimbal lock 
occuring when the product equals one. The goal of gimbal 
lock avoidance is to drive the product of the sines to zero. 
This is accomplished by setting either the inner or middle 
angle to 0 or 180 degrees . 

Only one angle need be controlled at a time. 
Figure 3.3 shows the regions where control would switch from 
one angle to another. This is based on the smallest of the 
absolute values of the sines. 

The missile motion input to the U and V gyros 
has a gain factor of SIN(A^) "SIN (Aj ) , as seen in Figure 3.1 
Thus, in addition to avoiding gimbal lock, nulling the 
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Figure 3.3 Gimbal Lock Avoidance Switching Line. 

product of the sines of the inner and middle gimbal angles 
also minimizes the effect missile motion has on gyro error. 

2 . Gyro Controller 
a. Control Laws 

Figure 3.4 shows the controller for the Mark 6 
gyro [Ref. 3: p. 115]. The six inputs to the controller are 
the three signals generated from the U,V and W gyros, the 
stable element gimbal angle and the sines of the inner and 
middle gimbal angles. The four outputs are the torque motor 
command signals. 
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Figure 3.4 Mark 6 Gyro Control Law. 
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b. Transfer Functions 

The transfer function H-^(z) in the stable 
element, inner and middle gimbal feedback paths is defined 
as : 

H-l(z) = (z-.932) 3 (z-.80955)/(z-1) 2 (z-.6186)(z- .17474) 

The transfer functions H 2 (z) and H 3 (z) in the 
outer gimbal control loop are: 

H 2 (z) = (z-.9778)/(z+.3827) 

H 3 (z) = (z-l)/z 

c. Redundant Torque 

The outer gimbal control loop has three inputs 
controlled by switches Q^,Q 2 and Q 3 . Two of the inputs are 
the SIN(Aj^) and SIN(Aj) signals. The third input is the 
stable element angle. The two signals generated by this 
loop are necessary when the product SIN ( Aj^)*SIN (Aj ) becomes 
very small and does not produce a large enough error signal 
to drive the outer gimbal. Q-^ and Q 3 are switches with 
values of +1 and -1 depending on gimbal geometry. Switch Q 2 
is closed for values of SIN(Aj^)*SIN (Aj ) less than 1/8, and 
open for values greater than 1 / 8 . 

d. Scaling Factors 

Gain blocks with 2 ^ 3 and l/2 ^ 3 scaling factors 
are included in the control laws. These gain factors are 
applied in order to facilitate software processing of the 
feedback signals only. 
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IV. STATE- SPACE MODEL 



A. BLOCK DIAGRAM 

1 . Plant Model 

The state-space model of the Mark 6 Gyro is shown in 
Figure 4.1. Where appropriate, the gains from Figure 3.1 
have been combined into a single block. Only the inner, 
middle and outer gimbals have been modeled. Eight states 

are identified on the figure. 

2 . Assumptions and Simplifications 

A number of assumptions and simplifications have 
been made in order to develop the state-space model: 

(a) there is no friction (this eliminates the stable 

element loop) 

(b) all states are available for feedback 

(c) the inner and middle angles are fed back directly, 

not the sines of the angles 

(d) there are no limiters in the system 

(e) the entire system is sampled at 300 Hz 

3 . State-Space Equations 

The state-space equations of the system are in the 

f orm : 

x(t) = A(t)x(t) + B(t)u(t) 

The vectors x(t) and u(t) are described in Table I. 
A(t) and B(t) are the plant and control matrices, respec- 
tively. The matrices for this system are shown in Figure 
4.2. 
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Figure 4.1 State Space Model of the Mark 6 Gyro. 
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TABLE I 

STATE AND CONTROL VECTORS 



X 1 


inner gimbal 


inertial rate I 


x 2 


U Gyro error 




x 3 


inner gimbal 


angle A M 


x 4 


middle gimbal 


inertial rate M 


x 5 


V Gyro error 




x 6 


middle gimbal 


angle 


x 7 


outer gimbal 


inertial rate 0 


x 8 


stable element gimbal angle 


U 1 


inner gimbal 


torque signal 


u 2 


middle gimbal 


torque signal 


u 3 


outer gimbal 


torque signal 



22 



Plant Matrix 
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where K = 1,077,470 



Control Matrix 



0.068 

0 

0 

0 

0 

0 

• s m/ j o 



0 

0 

0 

1/J M 

0 

0 

0 

0 



0 

0 
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0 
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0 

1/J 0 



0 

0 

_S M 

0 

0 

0 

0 

0 



Figure 4.2 Plant and Control Matrices for State-Space Model 
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V. OPTIMIZATION TECHNIQUE 



A. OPTIMAL REGULATOR 

1 . Linear Quadratic Problem 

The Mark 6 gyro model can be represented by the 
state differential equation 

x(t) = A(t )x(t ) + B(t)u(t) 

The goal of the optimization technique is to drive 
the system to the desired state as quickly as possible, 
while using only practical input amplitudes. The quadratic 
integral criterion can be used to express how rapid an 
initial state is driven to the final state [Ref. 4: p. 201]. 
This criterion can be expressed as: 



minimize the output state vector. The criterion as repre- 
sented above would require very large input amplitudes , 
usually unattainable in a practical system. Including the 
input in the quadratic integral yields 



By proper selection of R£ and R 3 , the output vector 
can be minimized using realizable input amplitudes. 

Since only the controlled variables are of interest, 
the cost equation can be written in terms of the output 
vector z(t), given as: 




R 3 (t) is an appropriate weighting matrix chosen to 




z ( t ) = D(t )x(t ) 



A weighting matrix Rj can now be defined as: 



R]_ ( t ) = D T (t)R 3 (t)D(t) 
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R^(t) is a square, positive semi-definite symmetric 
matrix having the same order as the number of controlled 
variables of the system. The selection of the specific 
values for and R 2 are discussed in the next section. 

The inputs for the Mark 6 gyro are the signals to 
the torque motors. These signals are generated solely as a 
function of gyro error and gimbal angular position. In the 
optimal regulator problem, the inputs can be expressed in 
terms of an optimal feedback gain matrix and the states. 

u(t) = -Fx(t) 

The state differential equation can then be written 

as : 

*(t) = A(t )x(t ) ♦ B ( t ) ( -Fx( t ) ) ♦ B(t)u 0 (t) 

When there are no external inputs, u Q (t)=0. 
Combining terms yields the following: 

x(t) = [A(t)-B(t)F(t)]x(t) 

In the linear quadratic problem, the control law can 
be expressed as: 

u(t) = -R 2 ~^B^Px(t) 

The optimal feedback gain matrix now becomes: 

F = R" 1 B T P 



tion: 



The matrix P is found by solving the Riccati equa- 



PA + A T P - PBR 2 ' 1 B T P + R x = 0 

This is the solution for the steady-state optimal 
feedback gains, and is the method used to develop the feed- 
back gain matrices used to control the Mark 6 gyro. 
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2 . Choice of Weighting Matrices 

The weighting matrices R-^ and R£ were chosen based 

on the maximum values that the output vector and inputs 

could be expected to reach. When the weighting matrices 

T 

have values only on the diagonal, the matrix product x Rx 
becomes x^ /R^ for each of the values of x. R^ is then 
set equal to the inverse of the maximum expected value of x^ 
squared. This drives each of the terms in the cost equation 
to one when their value approaches the maximum allowed, and 
to zero when their value is small. 

3 . Non- zero Steady State Outputs 

The solution to the linear quadratic optimal feed- 
back gain problem has been outlined in the previous 
sections. This solution assumes, however, that the desired 
steady-state value of the controlled states is zero. Since 
the Mark 6 control law includes nulling the sine of the 
inner or middle angle, it is possible that the desired value 
of the inner or middle angle be 180 degrees, not 0. In this 
case, the optimal feedback gain control law becomes: 

u(t) = -F[-R+x(t )] 

The vector R here represents the reference signal in 
the system, as shown in Figure 5.1. When R=0, the optimal 
control solution reduces to that shown above. 

In addition to an axis shift, driving the system to 
a non- zero set point can also be accomplished by adding a 
constant factor u Q to the control input u(t). The control 
input then becomes: 

u(t) = -Fx ( t ) + u Q 

A u Q can be chosen such that when the system experi- 
ences a shift in the set point, as the gyro controller does 
when shifting from 0 to 180 degrees, an optimal response is 
obtained while remaining within allowable input amplitudes. 
[Ref. 4: pp . 270-275]. 
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Figure 5.1 Optimal Gain Feedback Block Diagram. 

This optimal constant input is defined as: 

U Q = H c ' 1 (0)z o 

In this equation, H c (s) is the closed loop transfer 
function from the inputs to the desired non-zero steady 
state output z Q . The use of this solution requires that the 
number of inputs is equal to the number of outputs, and that 
the inverse of transfer function H c (s) exists. If the 
transfer function has any zeros at the origin, the matrix 
H c (0) is singular and the inverse does not exist. 

The optimal solution for the gyro controller gener- 
ates one or more zeros at the origin depending on the 
particular gimbal angles. Thus, the optimal input u Q cannot 
be found and the axis shift technique must be used. 

B. MARK 6 GYRO OPTIMAL CONTROLLER 
1 . Region Controller 

With a sampling rate of 300 Hz, computing the 
optimal feedback gains every sampling interval would require 
an enormous amount of computations. Lauro has shown that a 
region controller will yield a nearly optimal response while 
greatly reducing the calculations involved [Ref. 1: p. 8]. 
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The plant and control matrices of the Mark 6 gyro are a 
function of the gimbal angles, which in turn vary with time. 
The optimal regulator designed for the system divides the 
gimbal angle regions up into segments of 30 degrees or less. 
Optimal gains for the gimbal angles at the center of the 
region have been calculated. When the missile motion causes 
the gimbal angles to change from one region to another, the 
controller inserts the feedback gains calculated for that 
region. Figure 5.2 shows typical regional divisions for two 
angles. The regions are 10 degrees wide near zero, and 30 
degrees wide further from the origin. The figure shows a 
two dimensional plot, although the actual gyro controller 
involves four angles in four dimensional space. 




Figure 5.3 contains the algorithm of the computer 
program written to implement the optimal regulator. A copy 
of the program listing is included in Appendix C. 
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initialize missile motion and gyro rates to zero 

assign initial gimbal angles 

determine initial condition vector x(0) 

restrict all angles to +/- 360 degrees 

determine optimal gain region based on gimbal angles 

assign appropriate optimal feedback gains 

calculate variable terms in plant and control matrices 

input missile motion 

calculate x(k+l) values for each state 
Figure 5.3 Algorithm for the Mark 6 Gyro Optimal Regulator. 
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VI. SYSTEM SIMULATION 



A. SIMULATION MODEL 

The model used for system simulation is a modified 
version of the state-space model shown in Figure 4.1. The U 
and V gyro errors are integrated, and the result nulled to 
minimize net gyro errors . The outer gimbal angle is calcu- 
lated since it affects the plant and control matrices, but 
is not used for optimal feedback. The simulation model has 
eleven states, and is shown in Figure 6.1. The plant and 

control matrices for the simulation model are given in 
Figures 6.2 and 6.3. 

B. WEIGHTING MATRICES 

1 . Torque Limits 

Each axis of the gyro is driven by a torque motor. 
The amount of torque delivered by the motor is directly 
proportional to the feedback error signal. When the gyro 
errors are zero and the sine of the selected gimbal angle 
has been driven to null, no torque is generated. 

The maximum torques which can be supplied to each 

axis are 

• maximum inner axis torque Tj max 83 oz-in 

• maximum middle axis torque T^ max 211 oz-in 

• maximum outer axis torque TQ max 369 oz-in 

Up to 14 percent more torque is available dependent 
upon the particular gimbal angles. This additional torque 
was not assumed to be available when designing the state- 
space system. 

2 . State Output Weighting Matrix 

The optimal control cost function is defined as 

J = J [z T (t)R 1 (t)z(t) + u T (t)R 2 (t)u(t)]dt 

The output measurement vector z(t) is 

z(t) = [x 2 (t) x 3 (t) x 5 (t) x 6 (t) x 10 (t) x 11 (t)] T 
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Figure 6. 
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Plant Matrix for the State-Space Simulation Model. 
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Figure 6.3 Control Matrix for the 
State Space Simulation Model. 



The output vector weighting matrix was chosen based 
on data provided by Draper Laboratory. The output vector 
varies with time depending on gimbal angles. The states 
which comprise the output vector and their maximum allowable 
values are shown in Table II. 



TABLE II 

OUTPUT STATE VECTOR MAXIMUM VALUES 



x 2 


U Gyro 




300 quanta 


x 3 


inner i 


gimbal angle 


30 degrees 


x 5 


V Gyro 




300 quanta 


x 6 


middle 


gimbal angle 


30 degrees 


x 10 


V Gyro 


error integral 


1 


X 11 


U Gyro 


error integral 


1 



The maximum value of 300 quanta listed for the gyro 
angles corresponds to an error of 0.278 milliradians . This 
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is the maximum error attained with the current Mark 6 gimbal 
model. It was desired to allow a smaller error in the 
state-space model. The gyro has a physical stop at 2048 
quanta, or 1.9 milliradians . If the error reaches this 

value the system will fail. 

The inner and middle gimbal angle maximum values 
were chosen as 30 degrees. This prevents the product 

SIN(Aj,j) SIN(Aj ) from exceeding 0.5. 

The maximum value of the integrals of the U and V 
gyro errors was chosen arbitrarily as 1. This limit mini- 
mized gyro error without producing excessive input ampli- 
tudes . 



The matrix in terms of the output variables is 



R 1 = 



1/ (x 2 ), 



0 

0 

0 

0 

0 



1 /(x 3 ) ( 



0 

0 



0 

0 



0 

0 

0 

0 



1 /( x s)n 2 



"5 7 o 

° l/(* 6 )o : 

0 0 

0 0 



0 0 

0 0 

0 0 

0 0 

l/(x 10 ) o 2 0 

0 l/(xn ) 0 2 



Using the maximum values of the output states as 
given in Table II, The output cost matrix becomes 







1.11x10 
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3.65 
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1. llxlO" 5 
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0 
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.65 
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Control 


Input 


Weighting Matrix R 
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The control input weighting matrix 


is a third 


order 


symmetric matrix 


with 


the inverse 


of the 


square of 


the 


allo- 


wable 


torques , 


given 


previously 


, on 


the 


diagonal . 


The 



matrix is shown below. The inputs are related to the 
torques as follows: 
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• = inner axis torque Tj 

• u £ — middle axis torque 

• u^ = outer axis torque Tq 



r 2 = 



1 / (t t ) 2 0 0 

0 1/(T m ) 2 0 

0 0 1/(T 0 ) 2 



Using the maximum torque 
the R 2 matrix is: 



values given previously, 



r 2 



1.45xl0~ 4 

0 

0 



0 0 
2.25xl0' 5 0 

0 7 . 34x10" ^ 



C. TEST PARAMETERS 

1 . Initial Conditions 

The initial conditions used for the model simulation 
were provided by Draper Laboratory. This particular combi- 
nation of initial conditions, along with the missile motion, 
has been determined to be the "worst case" situation for 
gyro control. 

The gimbal angles have been initialized as follows: 

• stable member gimbal angle - 0 degrees 

• inner gimbal angle - 90 degrees 

• middle gimbal angle - 0 degrees 

• outer gimbal angle - 59.25 degrees 

The system is started from rest, with all gimbal and 
angular rates zero. The initial condition vector z(0) is: 
x x (0) = 0 
x 2 (0) = 0 

x^CO) = 90 degrees 
x 4 (0) = 0 
x 5 (0) = 0 
x 6 (0) = 0 
x 7 ( 0 ) = 0 
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x 8 (0) = 0 

Xg(0) = 59.25 degrees 
x 10 (0)= 0 
x n (0)= 0 

2 . Missile Motion 

The missile motion used for the simulation is a 

O 

pitch rate input. The input is applied at 8 rad/sec to a 
steady-state value of 1.571 rad/sec, or 90 deg/sec. The 
input reaches steady-state after 0.19 seconds. 

D. TEST RESULTS 

The system was initialized using the values above, and 
the pitch input applied. The tabulated data for the simula- 
tion run is included in Appendix D. 

Figure 6.4 shows a plot of U and V gyro error as a func- 
tion of time. The switching points between optimal gain 
regions are shown on the figure. The error graphs show a 
transient error spike when the optimal gains are changed. 
The amplitude of this spike can be made arbitrarily small by 
reducing the size of the optimal control regions. If 
optimal gains were calculated and applied every sample 
interval, the curve would show no such fluctuations. 

A comparision between the errors of the Draper lab Mark 
6 model and the state- space model with optimal control 
region gains is shown in Figures 6.5 and 6.6. The UGSGF 
error signal, Figure 6.5, closely approximates the Draper 
model with the exception of the switching point transients. 
The error damps rapidly after the optimal gain change, main- 
taining a small steady state error. The pitch input to the 
U gyro has a gain including both the SIN(Aj^) “SIN (Aj ) term 
and a SIN(Ag) term, as seen in Figure 4.1. Since both the 
middle and stable gimbal angles are initially zero, the 
pitch rate does not affect the U gyro significantly at the 
start of the simulation run. 
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Figure 6.4 U and V gyro Errors for the State-Space Model. 
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The VGSGF error signal graph, Figure 6.6, shows a less 
pronounced response to missile motion than that experienced 
by the Draper model. The error transients again damp out 
quickly, with the system approaching but not attaining zero 
error at the end of the simulation run. The V gyro shows an 
immediate response to missile motion since the gain block 
contains a COS(Ag) term, allowing the pitch rate to affect 
the gyro error as soon as the middle gimbal angle moves away 
from zero. 

The maximum gyro errors of the Draper lab model and the 
optimal model, neglecting the transient error spikes, are 

• U gyro error Draper lab model 12 quanta 

• U gyro error optimal model 10 quanta 

• V gyro error Draper lab model 94 quanta 

• V gyro error optimal model 31 quanta 

The maximum transient errors of the optimal model are 

• U gyro error 83 quanta 

• V gyro error 63 quanta 

Figure 6.7 compares the inner versus middle gimbal angle 
of the Draper model and the state-space model. The 
state-space model exhibits a more rapid middle gimbal angle 
change than the Draper model. The angular rate of the 
middle gimbal angle could be slowed down by varying the 
maximum allowed value of the angle in the R 2 weighting 
matrix. A slower angular rate would result in a smaller 
middle gimbal angle, and the SIN(Aj^) term in the gain path 
would reduce the effect the missile motion had on the U and 
V gyro errors. A trade-off between the two must be made, 
however, since the input signals required to hold the middle 
angle at a slower rate may adversely affect the gyro errors. 

The inner gimbal angles of both systems translate at 
approximately the same rate. This can be expected since the 
sine of the middle angle, not the inner angle, is being 
nulled at the start of the simulation. The inner gimbal 
angle is not being controlled. 
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Figure 6.5 UGSGF Errors - Draper Lab and State-Space Models. 
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Figure 6.6 VGSGF Errors - Draper Lab and btate-bpace noaeis. 
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Figure 6 . 7 Inner and Middle Gimbal Angles . 
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VII. CONCLUSIONS AND RECOMMENDATIONS 



A. CONCLUSIONS 

1 . Optimal Design Techniques 

It has been shown that an optimal feedback gain 
controller can successfully control gyro errors and prevent 
gimbal lock. The unique, non-linear nature of the Mark 6 
Gyro requires that several modifications be made to the 
linear quadratic problem solution. 

As the gimbal angles vary, the internal plant gains 
vary. Depending on the gyro orientation, these gains can 
range from zero to one. Care must be taken in the regions 
surrounding zero gain, since the loop is effectively broken 
at this point. If the optimal control regions chosen are 
too large, the instantaneous switching of the gain from zero 
to a finite value may cause large transient errors from 
which the system is unable to recover. Narrowing the 
optimal control regions near the zero points will lessen the 
impact of the loop suddenly being closed. Increasing the 
number of control regions would also increase the memory 
size required to store the additional gain values. There 
exists a trade-off between system performance and the amount 
of control hardware required to implement the system. 

The constantly changing gimbal angles also lead to 
numerous set point shifts. It was shown in chapter five 
that there exists an optimal control input which drives the 
state to the desired value without exceeding the input 
amplitude limitations. This solution requires that the 
inverse of the closed loop transfer function exists and that 
the number of controlled states is equal to the number of 
inputs. [Ref. 4: p. 279]. If either of these conditions is 
not met, a set point axis shift must be used, which may 
cause large transient errors. Narrowing the optimal control 
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regions in these areas may improve system performance. 
Again, additional memory space would be required. 

B . RECOMMENDATIONS 

1 . Improving System Performance 

The gyro controller used in the simulation was 
designed using the linear quadratic optimal feedback gain 
design technique. Since the technique provides optimal 
control only at the design point, a region controller will 
not provide optimal response to missile motion throughout 
the region. Changing the weighting matrices and R 2 for a 
particular region may provide improved system performance 
while still remaining within the allowable torque limits. 
Since the maximum allowable value for the controlled gimbal 
angle and gyro error integrals are essentially arbitrary, 
they can be varied and the resulting system performance 
analyzed to determine if the error in that region can be 
reduced . 

The simulation model also neglected the effects of 
friction, which can reduce net torque to the axes by 3 to 4 
oz-in. The friction effects, which are a function of gimbal 
angular rate, may produce a marked decrease in system 
performance in areas where the angles are changing rapidly. 

Finally, the model assumed that all states were 
available for feedback and that there was no noise input. 
In practical applications, this assumption is invalid. A 
Kalman filter must be designed for the system to provide an 
estimate of the states which can not be measured, and to 
optimize system performance in the presence of both process 
and measurement noise. Harmonics from the gyros and the 
torque motors may have an effect on the system, along with 
structural noise generated during missile flight. The non- 
linearity and time varying nature of the system make the 
design of a filter particularly complex. 
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APPENDIX A 
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UGSGF 

VGSGF 

IMU 



DEFINITIONS 
TABLE III 

VARIABLE DEFINITIONS 

stable element gimbal angle 

inner gimbal angle 

middle gimbal angle 

outer gimbal angle 

stable member inertial rate 

inner gimbal inertial rate 

middle gimbal inertial rate 

outer gimbal inertial rate 

sine of stable element angle 

cosine of stable element angle 

sine of inner gimbal angle 

cosine if inner gimbal angle 

sine of middle gimbal angle 

cosine of middle gimbal angle 

sine of outer gimbal angle 

cosine of outer gimbal angle 

U gyro error signal expressed in quanta 

V gyro error signal expressed in quanta 

Inertial Measurement Unit 

the gyro and its controller 
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APPENDIX B 



A 



1. FOUR GIMBAL IMU MODEL 

This appendix develops the equations which govern the 
gyro motion due to inputs from missile motion and torque 
motors. A block diagram of the plant is developed from the 
equations, which also leads to the state-space model 
[Ref . 2 : pp . 2- 7] . 

1 . Assumptions and Approximations 

This analysis includes the following assumptions and 
approximations : 

• Spherical inertias 

• Small torques due to gyroscopic effects 

2 . Definitions 

Gimbal motion is positive in a clockwise direction. 
The transformation from an inner member to an outer member 
is then in the form: 



• Standard i,j,k axes will be used. 

• x, y and z are rate components on the i, j and k axes. 

• p, q and r are body, or missile, motion rates on the i, 
j and k axes representing pitch, roll and yaw respec- 
tively . 

• A positive torque T applied to a gimbal causes a posi- 
tive, clockwise rotation. 

• Ex, Ey and Ez are the gyro errors sensed on the stable, 
or inertial, member. 



inner member 



COS -SIN 0 

SIN COS 0 

COS 0 1 



C 

outer member 
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3 . Symbols 



• S - Stable member gimbal rate resulting from applied 

torque 

• 

• I - Inner member gimbal rate resulting from applied 

torque 

« 

• M - Middle member gimbal rate resulting from applied 

torque 

• 

• 0 - Outer member gimbal rate resulting from applied 

torque 

• 

• As - Stable member gimbal rate resulting from relative 
motion between gimbals 

• 

• Ai - Inner member gimbal rate resulting from relative 
motion between gimbals 

• Am - Middle member gimbal rate resulting from relative 
motion between gimbals 

• 

• Ao - Outer member gimbal rate resulting from relative 
motion between gimbals 

4 . Transformation of missile motion to inertial member 
a. Base motion 

Base motion Wb(5) = pi5 + qj5 + rk5 
referred to outer gimbal: (degree of freedom 

along j4 and j5) 



Wb 



0 




0 -So 

1 0 
0 Co 



P 

q 

r 



Wbx 




Co~'p - So- v r 


Wby 


= 


q 


Wbz 




GO 

O 

* 

T) 

+ 

n 

o 

* 

H 




0(4) 


— 



Rates along Wby do not couple to outer gimbal. 
0 is a rate applied to the outer gimbal from its torque 
motor . 
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Wox 




Co"'p - 


So*r 


Woy 


= 


0 




Woz 




So'"'p + 


Co*r 




0(4) 







b. Outer gimbal to middle gimbal transformation 

Referred to middle gimbal: (degree of freedom 

along the i3 and i4 axes) 



Wox 

Woy 


— 


”l 0 o" 

0 Cm - Sm 




Co'"p - So Vr r 
0 


Woz 


M(3) 


0 Sm Cm 




So' f p + Co*r 



Rates along 
gimbal. M is the rate 
torque motor. 



Co*p - So- v r 
Cm-'O - Sm(So*p + Co-r) 

Sm-'O + Cm(So"'p + Co*r) 
Wox|m do not couple to middle 
of middle gimbal applied by its 



Wmk 




M 


Wmy 


= 


Cm"0 - Sm" ( So “p + Co' ,<r p) 


Wmz 


M( 3 ) 


Sm'"0 + Cm'" ( So "p + Co"r) 



c. Middle gimbal to inner gimbal transformation. 

Referred to inner gimbal (degree of freedom 
along k2 and k3 axes): 
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Wmx 




Ci -Si 0 




M 


Wmy 


= 


Si Ci 0 




Cm*0 - Sm" ( So*p + Co*r ) 


Wmz 


1(2) 


0 0 1 




jjSm-'O + Cm*(So*p + Co*r) 



Ci*m - 


Si"'"Cm' v 0 


Si*m + 


Ci*ECm*0 


Sm"0 + 


Cm* ( So*p 



Sm* ( So "'p + 
Sm*(So*p + 
Co*r ) 



Co*r ) ' 
Co*r)T 



Rates along Wmz | I do not couple into inner 
gimbal. I is rate on inner gimbal applied by torque motor, 
therefore : 



Wix 




'"ci*M - Si*ECm*0 - Sm*(So*p + Co*r)T" 


Wiy 


= 


Si*M + Ci*ECm*0 - Sm*(So*p + Co*r)T 


Wiz 


1(2) 


I 



d. Inner gimbal to stable member transformation. 

Referred to stable member (degree of freedom 
along jl and j2 axes): 



Wix 




Cs 


0 -Ss' 




Wix 


Wiy 

Wiz 




0 

Ss 


1 0 
0 Cs 




Wiy 

Wiz 



S(l) 



Cs*Wix - Ss*Wiz 
= Wiy 

Ss*Wix + C s *W i z 

Rates along Wiy | s do not couple across. E is 
rate on stable member applied by motor, therefore: 
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Wex 
Wey = 
Wez 

S 



Cs*[Ci*M - Si*[Cm*0 - Sm-'CSo^'p + Co*r)]] - Ss*I 
E 

Ss*[Ci*M - Si*[Cm*0 - Sm*(So*p + Co *'r ) ] ] + Cs*I ^ 



e. Four Gimbal Block Diagram. 

The following expressions are used to develop 
the four gimbal IMU block diagram shown in Figure B.l: 



A E = W EYJl " W IYJ2 

A I = W IZ k 2 " W MZ k 3 

A M = W MX i 3 ‘ ^0X i 4 

A 0 = W 0YJ4 " W BY^5 
E y = E j 

E X = ^EX^l 
E Z = W EZ k l 
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Figure B.l 



Four Gimbal Gyro Block Diagram 
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APPENDIX D TABULATED DATA 
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